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FIG.5 

( RUNNING GAIT ) 




Title: "CONTROL DEVICE FOR LEGGED MOBILE ROBOT" 



First Named Inventoi Toru Takenaka 10^§0jL56>2 



National Stage of PCT/JP03/00435 
Customer No. 40854; Docket No. SAT-15629 
Page 6 of 51 



6/51 



FIG.6 

( DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT ) 
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FIG.8 

( BODY TRANSLATION MODE ) 
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(BODY ROTATION MODE) 
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FIG.13 

( DIVERGENCE STATE OF BODY POSITION ) 
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FIG.14 

( PROCESS OF DETERMINING NORMAL GAIT PARAMETER ) 
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FIG.15 

( RELATIONSHIP AMONG FOOT LANDING POSITIONS/POSTURES FOR NORMAL GAIT) 



NEXT TIME GAIT'S 
UST TIME SUPPORTING LEG 

SUPPORTING LEG COORDINATE SECOND TURNING 

COORDINATE SYSTEM 
SYSTEM CURRENT TIME GAIT Y ' 

Y ^\ k / 22L 



NEXT BUT TWO 
TIME GAIT'S 
SUPPORTING LEG 
COORDINATE 
SYSTEM 




CURRENT TIME 
SUPPORTING LEG 22R 
COORDINATE SYSTEM 



FIRST TURNING GAIT 



NEXT BUT ONE TIME GAIT'S 
SUPPORTING LEG 
COORDINATE SYSTEM 



Title: "CONTROL DEVICE FOR LEGGED MOBILE ROBOT' | A i r r\1 f / ^ 

First Named Inventor: Toru Takenaka * U * J V 1 J OlU 

National Stage of PCT/JP03/00435 
Customer No. 40854; Docket No. SAT-15629 
Page 14' of' 51 



14/51 

FIG.16 

( DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT ) 
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FIG.19 

(PROCESS OF SEARCHING INITIAL DIVERGENCE COMPONENT FOR NORMAL GAIT) 
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FIG.20 

( PROVISIONAL GAIT GENERATION PROCESS FOR NORMAL GAIT ) 
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FIG.21 

(PROCESS OF DETERMINING NORMAL GAIT INSTANTANEOUS VALUE) 
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FIG.22 

( PROCESS OF DETERMINING BODY HORIZONTAL ACCELERATION 
AND BODY POSTURE ANGULAR ACCELERATION FOR NORMAL GAIT) 



C ENTRY ) 



SET TIMES Tm,Ts2 AND Tm2 



S500 



S504 



k LIES BETWEEN 
TsANDTmOR 
BETWEEN 
Ts2 AND Tm2 ? 



C RETURN ) 



S502 YES 



NO 



DETERMINE BODY HORIZONTAL ACCELERATION a tmp THAT IS 
REQUIRED TO SATISFY CURRENT TIME (TIME k) DESIRED ZMP 
IN THE CASE WHERE ROBOT MOVES IN BODY TRANSLATION MODE 



S506 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
Fxtmp IN THE CASE WHERE BODY HORIZONTAL ACCELERATION IS a tmp 



S510 



S508 Fxtmp > Fxmax 



Fxtmp 



Jxtmp < Fxmin 



DETERMINE HORIZONTAL COMPONENT Fx 
OF FLOOR REACTION FORCE USING FORMULA: 
Fx = Fxmax 



ELSE 



Fx = 


Fxmin 




Fx- 


Fxtmp 



S512 
S514 



S516 



DETERMINE BODY HORIZONTAL ACCELERATION a OF BODY 
TRANSLATION MODE AND BODY ANGULAR ACCELERATION p 
OF BODY ROTATION MODE USING FORMULAS: 
a = a tmp + (Fx - Fxtmp)/ A Fp 
j3 = (atmp-a)*AMp/AMr 



SET BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PATTERN 



S518 



S520 



CALCULATE INSTANTANEOUS VALUE ZMPrec OF BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN AT TIME k 



0 = -ZMPrec*Fz(k)/AMr 



S522 



S524 



DETERMINE BODY HORIZONTAL ACCELERATION a tmp THAT IS 
REQUIRED TO SATISFY CURRENT TIME (TIME k) DESIRED ZMP IN THE 
CASE WHERE ROBOT MOVES ONLY IN BODY TRANSLATION MODE 



a = atmp-(AMr/AMp)*/? 



S526 



S528 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fx 
IN THE CASE WHERE BODY HORIZONTAL ACCELERATION IS a 



Title: "CONTROL DEVICE FOR LEGGED MOBILE ROBOT* 
First Named Inventor: Toru Takenaka 
National Stage of P£T/JP03/00435 
r 1 'Customer No. 40854; Docket No. SAT-1 5629 
Page 20 of 51 



10/50l56i 



20/51 



FIG.23 

FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 

DETERMINED WITHOUT TAKING ALLOWABLE RANGE INTO CONSIDERATION Fxtmp 

ALLOWABLE RANGE 




FLOATING 
PERIOD 



FIG.24 

FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
DETERMINED TAKING FLOOR REACTION FORCE'S HORIZONTAL 
COMPONENT ALLOWABLE LIMIT INTO CONSIDERATION Fx 



ALLOWABLE RANGE 



Fxtmp Fx 




< 



Ts 




FLOATING Tm 
PERIOD 



FLOATING 
PERIOD 



FIG.25 

BODY INCLINATION ANGULAR ACCELERATION £ 




FLOATING 
PERIOD 



*l 



Te 



FLOATING 
PERIOD 



Title: "CONTROL DEVICE FOR LEGGED MOBILE ROBOT" 
First Named Inventor: Toru Takenaka 
National Stage of PCT/JP03/00435 

sue ft f n mm tftig g ^W; 1 No - ^ 5629 



10/501562 



21/51 

FIG.26 
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FIG.29 
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( RELATIONSHIP AMONG BODY POSITIONS 
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FIG.32 

( PROCESS OF PROVISIONALLY DETERMINING CURRENT TIME GAIT PARAMETER ) 
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FIG.33 

(FLOOR REACTION FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE) 
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FIG.34 

(PROCESS OF CORRECTING CURRENT TIME GAIT PARAMETER IN SEARCHING MANNER) 
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S702 



S700 



oo 



CALCULATE PROVISIONAL CURRENT TIME GAIT TO END TIME BASED ON PROVISIONAL 
DESIRED ZMP AND OTHER CURRENT TIME GAIT PARAMETERS 



S704 



DETERMINE FINAL DIVERGENCE COMPONENT qO[k] FROM BODY POSITION/VELOCITY 

(Xe, Ve) AT THE END OF CURRENT TIME GAIT USING FORMULA: 

qO[k] = Xe + Vxe/coO 



DETERMINE FINAL DIVERGENCE COMPONENT ERROR errq USING FORMULA: 
errq = qO[k] - q" 



S706 



S708 YES 

r...r.. W T,..».'..n.,» , ,.rn.MO^ / QXIT REPETITION LOOP) 

errq FALLS WITHIN ALLOWABLE RANGE? < ^ y 



S710 



CALCULATE PROVISIONAL CURRENT TIME GAIT TO END TIME BASED ON DESIRED 
ZMP OBTAINED BY CORRECTING PROVISIONAL DESIRED ZMP ACCORDING TO 
RELATIONSHIP SHOWN IN FIGURE 38 ON THE ASSUMPTION THAT a = A a 



BASED ON BODY POSITION/VELOCITY (Xel, Vxel) ATTHE END OF CURRENT 
TIME GAIT WHICH IS RECALCULATED BASED ON CORRECTED DESIRED ZMP, 
DETERMINE FINAL DIVERGENCE COMPONENT ql [k] USING FORMULA: 
ql[k] = Xel+Vxel/coO 
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DETERMINE PARAMETER SENSITIVITY r USING FORMULA: 
r = (ql[k]-qO[k])/Ao 



S714 



S716 



ADD CORRECTION QUANTITY DETERMINED ON THE ASSUMPTION OF a = -errq/r 
TO PROVISIONAL DESIRED ZMP TO RENEW PROVISIONAL DESIRED ZMP 



S718 



DETERMINE BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN 
BASED ON DIFFERENCE BETWEEN FINAL BODY POSTURE ANGLE FOR PROVISIONAL 
CURRENT TIME GAIT AND INITIAL BODY POSTURE ANGLE FOR NORMAL GAIT AND 
DIFFERENCE BETWEEN FINAL BODY POSTURE ANGULAR VELOCITY FOR PROVISIONAL CURRENT 
TIME GAIT AND INITIAL BODY POSTURE ANGULAR VELOCITY FOR NORMAL GAIT 



DETERMINE, AS DESIRED ZMP PATTERN, PATTERN OBTAINED BY ADDING 
BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED 
VALUE PATTERN TO PROVISIONAL DESIRED ZMP PATTERN 
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FIG.35 

( PROCESS OF GENERATING PROVISIONAL CURRENT TIME GAIT ) 
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INITIALIZE 

PROVISIONAL GAIT GENERATION TIME k=0 
VALUES IN CURRENT TIME SUPPORTING LEG COORDINATE SYSTEM 
CONVERTED FROM FINAL STATE OF LAST TIME DESIRED GAIT IS USED 
AS INITIAL STATES OF CURRENT TIME GAIT 
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S804 YES 


CURRENT TIME GAIT INSTANTANEOUS 
VALUE DETERMINATION SUBROUTINE 


k < Tcurrs? <^ 






k = k + Ak S808 



S806 
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FIG.36 

(PROCESS OF DETERMINING CURRENT TIME PROVISIONAL GAIT INSTANTANEOUS VALUE) 
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DETERMINE DESIRED FLOOR REACTION FORCE'S VERTICAL 
COMPONENT AT TIME k BASED ON GAIT PARAMETER 



S900 



DETERMINE DESIRED ZMP AT TIME k BASED ON GAIT PARAMETER 



S902 



DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURE AT TIME k BASED ON GAIT PARAMETER 



S904 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION THAT SATISFIES 
DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 
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CALCULATE BODY VERTICAL POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION 



S908 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmax] AT TIME k BASED ON GAIT PARAMETER 



S910 



DETERMINE BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION FOR CURRENT TIME PROVISIONAL GAIT SO AS TO SATISFY DESIRED 
ZMP IN SUCH A MANNER THAT FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
Fx DOESN'T EXCEED [Fxmin, Fxmox] 



S912 



CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGULAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION AND INTEGRATES THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE ANGLE 
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FIG.37 

( PROCESS OF DETERMINING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION FOR PROVISIONAL CURRENT TIME GAIT) 
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SI 002 



SI 000 NO 



DETERMINE BODY HORIZONTAL ACCELERATION a tmp THAT IS REQUIRED 
TO SATISFY DESIRED ZMP AT PRESENT TIME (TIME k) IF ROBOT IS CAUSED 
TO PERFORM MOVEMENT OF BODY TRANSLATION MODE 



k LIES WITHIN 
BODY 

INCLINATION 
ANGLE 
RESTORING 
PERIOD 
[To, lb]? 
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SI 004 



OBTAIN FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fxtmp 
WHERE BODY HORIZONTAL ACCELERATION IS a tmp 



SI 008 



SI 006 Fxtmp > Fxmax 



Fxtmp 



Jxtmp < Fxmin 



DETERMINE FLOOR REACTION FORCE'S 
HORIZONTAL COMPONENT Fx BY THE 
FOLLOWING EQUATIONS Fx = Fxmax 



Fx = Fxmin 



ELSE 



Fx = Fxtmp 



SI 010 
SI 01 2 



SI 01 4 



DETERMINE BODY HORIZONTAL ACCELERATION a OF BODY 
TRANSLATION MODE AND BODY ANGULAR ACCELERATION 
j8 OF BODY ROTATION MODE BY THE FOLLOWING EQUATIONS 
a = a tmp + (Fx - Fxtmp)/ A Fp 
j3 = (atmp-a)*AMp/AMr 



YES 



SET PATTERN OF ZMP-CONVERTED VALUE OF 
BODY INCLINATION RESTORING MOMENT 



SI 01 6 



SI 01 8 



CALCULATE INSTANTANEOUS VALUE OF PATTERN OF ZMP-CONVERTED 
VALUE OF BODY INCLINATION RESTORING MOMENT ZMPrec AT TIME k 



p = -ZMPrec* Fz(k)/AMr 



SI 020 



SI 022 



OBTAIN HORIZONTAL BODY ACCELERATION a tmp REQUIRED TO 
SATISFY DESIRED ZMP AT PRESENT TIME (TIME k) IF ROBOT IS 
CAUSED TO PERFORM MOTION IN BODY TRANSLATION MODE ONLY 



a = a tmp - (AMr/AMp)*ff 



SI 024 



SI 026 



OBTAIN FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fx 
WHEN HORIZONTAL BODY ACCELERATION IS a 
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FIG.38 

( CORRECTION OF DESIRED ZMP ) 

PROVISIONAL DESIRED ZMP 

X 

FREE LEG'S HEEL POSITION 
AT THE END OF GAIT 



SUPPORTING LEG'S 
TOE POSITION 



SUPPORTING LEG'S ' 
HEEL POSITION 




ZMP CORRECTION QUANTITY 



DESIRED ZMP 

X 

FREE LEG'S HEEL POSITION 
AT THE END OF GAIT 

SUPPORTING LEG'S 
TOE POSITION 

SUPPORTING LEG'S' 
HEEL POSITION 



WHOLE SOLE 
CONTACTING PERIOD 



ONE-LEG SUPPORTING 
PERIOD 




ONE-LEG SUPPORTING 
PERIOD 




WHOLE SOLE 
CONTACTING PERIOD 



ONE-LEG SUPPORTING 
PERIOD 



FLOATING 
PERIOD 



FLOATING 
PERIOD 



FLOATING 
PERIOD 
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FIG.39 

( SUPPORT POLYGON AND ZMP ALLOWABLE RANGE ) 
ZMP ALLOWABLE RANGE 

(FLOOR REACTION FORCE CENTRAL POINT ALLOWABLE RANGE) 




LEFT FOOT 



X(FORWARD) 



RIGHT FOOT 
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FIG.40 

( PROCESS OF DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE ) 
( ENTRY ) 

SI 000 



DETERMINE DESIRED FLOOR REACTION FORCE'S VERTICAL 
COMPONENT AT TIME t BASED ON GAIT PARAMETER 



DETERMINE DESIRED ZMPATTIME k BASED ON GAIT PARAMETER 



SI 002 



DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURES AT TIME t BASED ON GAIT PARAMETER 



SI 004 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION SATISFYING 
DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



SI 006 



CALCULATE BODY VERTICAL POSITION SATISFYING 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION 



SI 008 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmox] AT TIME t BASED ON GAIT PARAMETER 



S1010 



DETERMINE FLOOR REACTION FORCE'S MOMENT ALLOWABLE RANGE 
AT TIME t BASED ON GAIT PARAMETER 



SI 011 



SI 01 2 



DETERMINE BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION OF CURRENT TIME GAIT SO THAT MODEL MANIPULATION FLOOR REACTION 
FORCE'S MOMENT IS GENERATED ABOUT DESIRED ZMP AND THAT FLOOR REACTION 
FORCE'S HORIZONTAL COMPONENT Fx DOES NOT EXCEED [Fxmin, Fxmox] 



CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGULAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION, AND INTEGRATE THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE ANGLE 



SI 01 4 
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FIG.41 

( PROCESS OF DETERMINING BODY HORIZONTAL ACCELERATION/BODY 
POSTURE ANGULAR ACCELERATION OF CURRENT TIME GAIT ) 



SHOO NO 



CURRENT TIME t 
FALLS WITHIN 
BODY 

INCLINATION 
ANGLE 
RESTORING 
PERIOD 
[To, Tb]? 



( RETURN ) 



YES 



SI 102 



DETERMINE BODY HORIZONTAL ACCELERATION a tmp REQUIRED 
TO GENERATE MODEL MANIPULATION FLOOR REACTION FORCE'S 
MOMENT ABOUT PRESENT DESIRED ZMP (AT TIME t) IN THE CASE 
WHERE ROBOT MOVES IN BODY TRANSLATION MODE 



SI 104 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fxtmp 
IN THE CASE WHERE BODY HORIZONTAL ACCELERATION IS a tmp 



SI 108 



SI 106 Fxtmp > Fxmax 



Fxtmp ? 



Jxfmp < Fxmin 



DETERMINE FLOOR REACTION FORCE'S 
HORIZONTAL COMPONENT Fx 
WITH FORMULA: Fx = Fxmax 



Fx - Fxmin 



ELSE 



Fx = Fxtmp 



S1110 
S1112 



S1114 



DETERMINE BODY HORIZONTAL ACCELERATION a OF BODY, 
TRANSLATION MODE AND BODY ANGULAR ACCELERATION p 
OF BODY ROTATION MODE WITH FORMULAS: 
a = a tmp + (Fx - Fxtmp)/ A Fp 
13 = (atmp -a)*AMp/AMr 



SET BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PATTERN 



sn 16 



S1118 



CALCULATE INSTANTANEOUS VALUE OF BODY INCLINATION RESTORING 
MOMENT ZMP-CONVERTED VALUE PATTERN ZMPrec AT TIME t 



p =-ZMPrec*Fz(k)/AMr 



SI 120 



SI 122 



DETERMINE BODY HORIZONTAL ACCELERATION a tmp THAT IS 
REQUIRED TO GENERATE MODEL MANIPULATION FLOOR REACTION 
FORCE'S MOMENT ABOUT PRESENT DESIRED ZMP (AT TIME t) IN THE 
CASE WHERE ROBOT MOVES IN BODY TRANSLATION MODE 



a = atmp - (AMr/AMp)*/3 



SI 124 



SI 126 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fx 
WHEN BODY HORIZONTAL ACCELERATION IS a 
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FIG.42 

( DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT WHEN WALKING ) 



FLOOR REACTION FORCE'S VERTICAL COMPONENT 




TWO-LEG ONE-LEG SUPPORTING PERIOD 
SUPPORTING 
PERIOD 
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( START ) 



C 



INITIALIZE ( t =0 OR THE LIKE ) 
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FIG 44 

{ FLOWCHART OF GAIT GENERATION PROCESSING ) 
S2010 



S2012 



OO 



WAIT FOR TIMER INTERRUPTION ( FOR EACH CONTROL CYCLE ) 



S2014 



S2016 YES 



GAIT 
TRANSITION?' 



READ NEXT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, NEXT 
BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, CURRENT 
TIME GAIT'S PERIOD. AND NEXT TIME GAIT'S PERIOD 



t = 0 



S2018 



S2020 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S2022 



S2024 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENCE COMPONENT, INITIAL BODY POSITION/VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY) 



S2026 



PROVISIONALLY DETERMINE GAIT PARAMETER FOR CURRENT TIME GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



S2028 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT'S PARAMETER 
(CORRECT CURRENT TIME GAIT PARAMETERS IN SUCH A MANNER THAT 
FINAL DIVERGENCE COMPONENT FOR CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENCE COMPONENT FOR NORMAL TURNING GAIT) 



DETERMINE PARAMETERS OF FLOOR REACTION 
FORCE'S MOMENT ALLOWABLE RANGE 



S2029 



SUBROUTINE FOR DETERMINING ORIGINAL GAIT'S INSTANTANEOUS VALUE 
(DETERMINE ORIGINAL GAIT'S INSTANTANEOUS VALUES IN SUCH A MANNER THAT 
FLOOR REACTION FORCE'S MOMENT ABOUT DESIRED ZMP BECOMES ZERO) 



S2030 



SUBROUTINE FOR DETERMINING CORRECTED GAIT'S INSTANTANEOUS VALUE 
(WHILE CORRECTING DESIRED ZMP TO BE CLOSE TO ORIGINAL GAIT, DETERMINE 
CORRECTED GAIT'S INSTANTANEOUS VALUES TO GENERATE MODEL MANIPULATION 
FLOOR REACTION FORCE'S MOMENT ABOUT CORRECTED DESIRED ZMP) 



S2031 



DETERMINE ARM SWINGING MOVEMENT FOR CANCELING SPIN FORCE 



S2032 



t = t + At 



S2034 



END ) 
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FIG.45 

( PROCESS OF DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE ) 
C ENTRY ) 



DETERMINE DESIRED FLOOR REACTION FORCE'S VERTICAL 
COMPONENT AT TIME t BASED ON GAIT PARAMETER 



S2100 



DETERMINE DESIRED ZMP AT TIME t BASED ON GAIT PARAMETER 



S2102 



DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURES AT TIME t BASED ON GAIT PARAMETER 



S2104 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION THAT SATISFIES 
DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



S2106 



CALCULATE BODY VERTICAL POSITION SATISFYING 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION 



S2108 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmox] AT TIME t BASED ON GAIT PARAMETER 



DETERMINE FLOOR REACTION FORCE'S MOMENT ALLOWABLE RANGE AT 
TIME t BASED ON GAIT PARAMETER 



S2110 



S2111 



DETERMINE MODEL MANIPULATION FLOOR REACTION FORCE'S MOMENT, DESIRED 
FLOOR REACTION FORCE'S MOMENT FOR COMPLIANCE CONTROL, BODY HORIZONTAL 
ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION TO SATISFY 
CONDITIONS OF FLOOR REACTION FORCE'S MOMENT ALLOWABLE RANGE AND FLOOR 
REACTION FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE 



S2112 



CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGULAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION, AND INTEGRATE THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE ANGLE 
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FIG.46 

( PROCESS OF DETERMINING BODY HORIZONTAL 
ACCELERATION/BODY POSTURE ANGULAR ACCELERATION ) 



( ENTRY ) 



DETERMINE MODEL-TO-MODEL BODY HORIZONTAL POSITION DIFFERENCE 
WHICH IS DIFFERENCE BETWEEN BODY HORIZONTAL POSITION OF 
CORRECTED GAIT AND BODY HORIZONTAL POSITION OF ORIGINAL GAIT 



S2200 



DETERMINE MODEL-TO-MODEL BODY POSTURE ANGLE DIFFERENCE 
WHICH IS DIFFERENCE BETWEEN BODY POSTURE ANGLE OF CORRECTED 
GAIT AND BODY POSTURE ANGLE OF ORIGINAL GAIT 



BASED ON MODEL-TO-MODEL BODY HORIZONTAL POSITION DIFFERENCE, 
DETERMINE REQUIRED VALUE OF MODEL'S BODY HORIZONTAL POSITION 
STABILIZATION FLOOR REACTION FORCE'S MOMENT REQUIRED TO 
CONVERGE THE DIFFERENCE TO ZERO 



S2202 



S2204 



BASED ON MODEL-TO-MODEL BODY POSTURE ANGLE DIFFERENCE, 
DETERMINE REQUIRED VALUE OF MODEL'S BODY POSTURE ANGLE 
STABILIZATION FLOOR REACTION FORCE'S MOMENT REQUIRED TO 
CONVERGE THE DIFFERENCE TO ZERO 



S2206 



S2208 



DETERMINE MODEL'S BODY HORIZONTAL POSITION STABILIZATION MOMENT 
AND MODEL'S BODY POSTURE ANGLE STABILIZATION MOMENT TO SATISFY 
RESTORING CONDITIONS, AND FURTHER DETERMINE BODY HORIZONTAL 
ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION 



MODEL MANIPULATION FLOOR REACTION FORCE'S MOMENT 
= MODEL'S BODY HORIZONTAL POSITION STABILIZATION MOMENT 
+ MODEL'S BODY POSTURE ANGLE STABILIZATION MOMENT 



S2210 



DESIRED FLOOR REACTION FORCE'S MOMENT FOR COMPLIANCE CONTROL 
= COMPENSATING TOTAL FLOOR REACTION FORCE'S MOMENT Mdmd 
+ MODEL MANIPULATION FLOOR REACTION FORCE'S MOMENT 



S2212 
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INITIALIZE ( t =0 OR THE LIKE) 



40/51 

FIG.48 

( FLOWCHART OF GAIT GENERATION PROCESSING ) 
S3010 



oo 



WAIT FOR TIMER INTERRUPTION ( EACH CONTROL CYCLE ) 



S3014 



S3016 YES 



GAIT 
TRANSITION?^ 



t = 0 



S3018 



S3020 



READ NEXT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT'S PERIOD, AND NEXT TIME GAIT'S PERIOD 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS FOR NORMAL GAIT 



S3022 



S3024 



SUBROUTINE FOR DETERMINING INITIAL STATE OF NORMAL GAIT 
(INITIAL DIVERGENCE COMPONENT AND THE LIKE) 



S3026 



PROVISIONALLY DETERMINE GAIT PARAMETER FOR CURRENT TIME GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



S3028 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETER 
(CORRECT CURRENT TIME GAIT'S PARAMETERS IN SUCH A MANNER THAT 
FINAL DIVERGENCE COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENCE COMPONENT OF NORMAL TURNING GAIT) 



DETERMINE PARAMETERS OF ZMP ALLOWABLE RANGE 
AND FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE FOR FULL-MODEL CORRECTION 



S3030 



SUBROUTINE FOR DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE 



DETERMINE ARM SWINGING MOVEMENT FOR CANCELING SPIN FORCE 



S3034 



S3032 



S3036 



DETERMINE INSTANTANEOUS VALUES OF ZMP ALLOWABLE RANGE AND FLOOR REACTION 
FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE FOR FULL-MODEL CORRECTION 



GENERATE CORRECTED GAIT USING FULL MODEL 



S3038 



t = t + At 



S3040 



END ) 
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FIG.50 

( PERTURBATION MODEL FOR CORRECTING HORIZONTAL BODY POSITION ) 



Z 



BODY MATERIAL PARTICLE'S HORIZONTAL POSITION Xc 

BODY MATERIAL PARTICLE (INVERSE 

PENDULUM 



FULCRUM 




HEIGHT OF 

INVERSE 

PENDULUM 



MATERIAL PARTICLE) 



BODY MATERIAL 
PARTICLE'S VERTICAL 
POSITION Zc(=Zb) 



DESIRED ZMP VERTICAL POSITION 
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